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[57] ABSTRACT 

A control system for a self-moving vehicle is provided 
with a pair of driving wheels on both sides of a shaft of 
a vehicle, motors for driving the driving wheels, veloc- 
ity encoders for outputting velocity feedback signals in 
detecting the rotational velocities of the driving wheels 
being connected to the driving wheels, a main control 
apparatus for outputting velocity instruction signals 
instructing the rotational velocities of motors being 
given a direction instruction signals, a gyro for detect- 
ing a yaw rate of the vehicle, and a motor control appa- 
ratus for executing the controls of motors in integrating 
the velocity instruction signals and the velocity feed- 
back signals with integrators for each period of time, 
and correcting the integrated velocity instruction sig- 
nals with the integrated velocity feedback signals. The 
main control apparatus outputs the velocity instruction 
signal corrected with the integrated value of the yaw 
rate in the case where the integrated value of the yaw. 
rate detected by the gyro for each fixed period of time 
is larger than a specified value or the value of the yaw 
rate is larger than another specified value so as to obtain 
an optimum directional and speed control of said self- 
moving vehicle without receiving an error from said 
gyro. 

2 Claims, 5 Drawing Sheets 
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comprises, an encoder connected to each driving wheel 

CONTROL SYSTEM FOR A SELF-MOVING f or detecting each speed of the wheels and for produc- 

VEHICLE bg a speed signal, an A/D converter responsive to the 

™ ^^.x^ r^r,^T^*^vr gyro signal for converting an analogue signal into a 

BACKGROUND OF THE INVENTION 5 gjod Sal and for generating the digital signal, a 

1. Field of the Invention gyro integrator responsive to the digital signal for inte- 
The present invention relates to a system for control- grating the digital signal and for generating a feedback 

ling traveling movements of a self-moving vehicle. a controller responsive to the integrated 

2. Description of the Related Art for ^n^ng ^ rot ational speed of the motor 
A self-moving vehicle, in general, has a driving wheel 1U e 77 ^- ~7l , ■ , rt _ , 

on each lateral side. Each driving wheel is driven in " d for ?«era^g a conimand signal a speed mtegrator 

rotation by a respective motor. The travel control of "sponsrve to the command signal for integrating the 

such a self-moving vehicle is accomplished by control- command signal and for generating an integrated signal, 

ling the rotation of the motors to maintain a constant a motor controller responsive to the speed signal and 

travel direction or course of the vehicle. 15 the command signal for integrating the both signals per 

Some of the conventional travel control systems for a predetermined time and for correcting the command 

self-moving vehicles are disclosed in Japanese Patent signal, and the main controller derives a correction 

Appln. Laid-Open No. 63-24161 1 and Japanese Patent signal of the command signal by integrating a yaw rate 

Appln. Laid-Open No. 64-10613. In these systems, the per the predetermined time when the yaw rate or an 

traveling direction of the vehicle is detected with a 20 mtegrated yaw ^ ^ ^ predetermined time is 

gyro. Corrections of the direction are performed by ^ her ^ a predetermined value so as to obtain an 

steering to maintain an instructed direction by compar- °' 0 „j ^ir mnii 

ing the actual traveling direction with the instructed pptmiurn drrecbonal and speed control of the self-mov- 

direction mg vcmclc wrthout receiving an error from the gyro. 

An error can be produced in an output signal from 25 Only a feedback control of a motor based on a veloc- 

the gyro by an integration error, or a voltage drift in a »ty signal and a velocity feedback signal is executed, 

circuit, when the gyro is used as a direction sensor. The when the value of the yaw rate detected by the gyro, or 

error has a tendency to increase with elapse of time, the travel eccentric angle of the vehicle, an integrated 

being influenced by integration. Therefore, there has yaw rate per the predetermined time is smaller than the 

been a problem that it becomes impossible to detect 30 predetermined value. Then a correction of a direction is 

accurately the actual traveling direction of the vehicle. without being affected by a voltage drift or an 

Consequently, the actual traveling direction may devi- error m ^ integrated value which can be produced in 

ate from the instructed direction. ^ 0 

An apparatus for controlling , thei travel of the vehicle * ^ correction mentioned above, the 

without using the gyro is disclosed m Japanese Patent 35 , "~ mwuuu««i aw ^ ^ 

Appln. Udd5)pen Na 3-6606. In the apparatus, the ™> ] wth a * oublc b > ^ 

actual rotational displacements are compared with the feedback control of the motor as m the case of an occur- 

rotational displacements to be made by the driving rence of slippage of the driving wheel. Because the 

wheels on both sides for a predetermined period of time. value of the yaw rate or the travel eccentric angle is 

Then the traveling direction is controlled by controlling 40 larger than the predetermined value. Accordingly, a 

the motors on both sides which are provided for respec- direction correction corresponding to the circum- 

tive driving wheels based on the deviation between the stances can be executed by giving a velocity instruction 

two wheels. signal being corrected with the travel eccentric angle, 

It is found that the feedback control of a motor sys- ^ integrated yaw rate which can be detected without 

tern based on the rotational displacement of a motor is 45 ^ b ^ ^vaict of a slippage of a driving 

not able to cope with the trouble when a rotational whed> to ^ motor 
displacement is large, as in a case of a slip between a tire 

and a road surface. BRIEF DESCRIPTION OF THE DRAWINGS 

As described above, there have been problems in a 

conventional travel control system for a vehicle. That 50 attachcd drawings . 

is, when the gyro is used, the traveling direction of the FIO. 1 is a perspective view showing an external 

vehicle gradually deviates. When the feedback control view of a self-moving vehicle using a control system 

of the motor system is used, the feedback control be- according to a first embodiment of the present inven- 

comes unable to cope with trouble such as tire slippage. tion; 

qt rxrfxx Aovnp tup iwvPMnnw 35 FIG. 2 is a right side view showing the left side of the 

SUMMARY OF THE INVENTION Amoving vehicle; 

Accordingly, an object of the present invention is to FIG. 3 is a bottom view showing the bottom of the 

provide a travel control system for a self-moving vehi- self-moving vehicle; 

cle to maintain an instructed traveling direction. FIG. 4 is a schematic block diagram showing the 

To achieve the object mentioned above the present 60 ^ for ^ ^t-movrng vchiclc; 
invention provides the control system for the self-mov- ' „ n \ anttfnnr .k™*™* . ~^™i 
ing vehicle having, a pair of drive shafts coazially pro- M ™- 5 » 0X1 «P ^ry dia^am showing a control 
vided under each left and right side of the self-moving bl ~ k ° f j 1 * s ^ m for * e ^™>v»W 
vehicle, a pair of driving wheels supported on the driv- FIG. 6 is a vector diagram showing the relation be- 
ing shafts, each motor connected to the driving shafts, 65 the velocity vectors of the two side wheels and 
and a gyroscope mounted on a self-moving vehicle for the yaw rate of the self-moving vehicle; and 
detecting a direction to move and for generating a gyro FIG. 7 is a time chart indicating the change of the 
signal, an improvement of the control system which yaw rate with the elapse of time in the control system. 
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DESCRIPTION OF THE PREFERRED 
EMBODIMENTS 

A preferred embodiment of the present invention will 
become understood from the following detailed de- 5 
scription referring to the accompanying drawings. 

Referring to FIGS. 1, 2, and 3, a self-moving vehicle 
travels in a direction indicated by arrow F. Wheels 41 
and 44 are centrally provided in a front and a back of a 
body 40 of the vehicle. A pair of driving wheels 42 and 10 
43 are disposed on opposite lateral sides at a middle 
position of the body 40. Three cleaning brushes 51, 52. 
and 53 are provided on the bottom of the body 40. The 
cleaning brushes 51, 52, and 53 are rotated for cleaning 
a surface such as a floor, when the vehicle travels. 15 

FIG. 4 shows a block diagram of a control system for 
a self-moving vehicle according to the present inven- 
tion. A motor 4c is connected to the left driving wheel 

42. A motor 4* is connected to the right driving wheel 

43. The output terminals of a motor control apparatus 20 
20 are connected to the motors 4a and 46 respectively. 

A velocity encoder 5a is connected to the motor 4a A 
velocity encoder 56 is connected to the motor 4b, The 
output terminals of the velocity encoders 5a and 5b are 
connected to input terminals of the motor control appa- 25 
ratus 20. An output terminal of the main control appara- 
tus 10 is connected to another input terminal of the 
motor control apparatus 20. 

The control system comprises not only a feedback 
control system based on the rotational displacement of a 30 
motor but also a feedback control system using a gyro 1. 
The gyro 1, an A/D converter 2 and a gyro integrator 
3 are connected in series. An output terminal of the 
gyro integrator 3 is connected to an input terminal of 
the main control apparatus 10. 35 

As described above, the control system comprises a 
feedback control system of a motor and a feedback 
control system of a gyro. The systems are used appro- 
priately depending on the magnitude of an eccentric 
angle 0. The angle B is the angle of deviation from the 40 
instructed direction. FIG. 6 shows a yaw rate dfl/dt, 
which corresponds to the change rate, with the time of 
the travel eccentric angle 0. The yaw rate has the rela- 
tions with the velocity vectors of the wheels on both 
sides as shown in FIG. 6. A left driving wheel and a 45 
right driving wheel are disposed at a distance L on both 
sides of the vehicle 32. Each driving wheel rotates with 
a velocity and in a direction expressed by a vector V^or 
V/t. The vehicle 32 proceeds straight in the direction of 
arrow A, when the magnitudes of the velocity vectors 50 
\\t\ and | V/t | are equal to each other. The vehicle 
travels in an inclined direction indicated by arrow B, 
when the magnitude of the velocity vector | V£| of the 
left driving wheel is greater than the magnitude of the 
velocity vector | V/* | of the right driving wheel. In this 55 
case, it is decided whether the gyro feedback control is 
to be accomplished or not depending upon the magni- 
tude of an integrated yaw rate d0/dt per the predeter- 
mined time. 

FIG. 7 shows a manner in which the yaw rate d0/dt 60 
varies with the elapse of time during the travel of the 
vehicle 32. The yaw rate d0/dt is integrated per the 
predetermined time At. The control is executed only by 
the feedback control system of a motor, when the value 
of 6 is less than a predetermined value W as in the cases 65 
of No. n-3, No. n-2 and No. n-1, or when the yaw rate 
is less than a predetermined value o. The correction of 
the direction is made by not only the feedback control 



of a motor but the feedback control of a gyro, when the 
integrated yaw rate d0/dt, an angle 0, is greater than 
the predetermined value W or the yaw rate d0/dt is 
greater than the value o>. 

Next, detailed control elements and the operation 
according to the present invention will be described 
with reference to the control block diagram shown in 
FIG. 4. The main control apparatus 10 is raven a direc- 
tional instruction value Bs from the exterior and con- 
trols the motor control apparatus 20 on the basis of the 
directional instruction value Bs- The main control appa- 
ratus 10 comprises a comparator 11, a left motor veloc- 
ity instruction component 13 and a right motor velocity 
instruction component 14. The direction instruction 
value Bs is transmitted to the comparator 11 from the 
outside. A switch 12 is closed, when the gyro feedback 
control system is operated. A travel eccentric angle Br 
output from the gyro integrator 3 is input into the com- 
parator 12 as described later. In the comparator 12, the 
travel eccentric angle Br is subtracted from the direc- 
tional instruction value Bs, and a corrected directional 
instruction value Be is output The switch 12 is opened, 
when only a motor feedback control is operated. The 
direction instruction value Bs transmitted to the com- 
parator 11 is output as a directional instruction value Be- 

The directional instruction value Be output from the 
comparator 11 is input into the left motor instruction 
component 13 and the right motor instruction compo- 
nent 14. The left motor instruction component 13 and 
the right motor instruction component 14 output veloc- 
ity instruction signals Yi and Yr which instruct the 
rotational velocities of respective motor 4a, 4b on the 
basis of the directional instruction value Be- The veloc- 
ity instruction signals Yi and Yr are input into the 
motor control apparatus 20. 

The motor control apparatus 20 comprises a sub-con- 
trol apparatus 21 and driver circuits 28a and 286. The 
sub-control apparatus 21 comprises integrators 21a and 
216 corresponding to the driving wheels on both sides. 
The driver circuit 28a comprises a comparator 22a, a 
D/A converter 23a, a comparator 24a, a differential 
amplifier 25a, a velocity feedback circuit 26a, and an 
integrator 27a for the left driving wheel. The driver 
circuit 286 comprises a comparator 22b, a D/A con- 
verter 23b, a comparator 246, a differential amplifier 
25b, a velocity feedback circuit 26b. and an integrator 
276 for the right driving wheel. 

The velocity instruction signals p£. and Yr are respec- 
tively inputted into the integrators 21a and 216 of the 
sub-control apparatus 21. The integrators 21a and 216 
integrate the signals P/.and Yr per a predetermined time 
and provide rotational displacement instruction signals. 
The rotational displacement instruction signals indicate 
the values of the rotational displacements as numbers of 
pulses through which the driving wheels on both sides 
should rotate per the predetermined time respectively. 
The rotational displacement instruction signals P// and 
Yr are output to the comparators 22a and 226 in the 
driver circuits 28a and 286 On the other hand, velocity 
encoders 5a and 56 count the numbers of pulses per a 
predetermined number of rotations, which are detected 
when the shafts of motors 4a and 46 rotate, using a 
constant K^, (number of pulses/rad), and output velocity 
feedback signals Y r L and YrR. The feedback signals Y r L 
and YrR are inputted into the integrators 27a and 276. 
The integrators 27a and 276 integrate the feed back 
signals P r /,and Y r R per the predetermined time to obtain 
the displacements of actual rotations of the shafts of the 
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motors 4a and 4* per the predetermined time and pro- to obtain the travel eccentric angle 0 (deg) and outputs 
viding feedback rotational displacements signals Vol toe result. 

and Vqr- The feedback rotational displacements signals Next, the operation is as follows. When the travel 
Vol and Vor are outputted to the comparators 22a and eccentric angle 0 is greater than the value W or the yaw 
22h In the comparators 22a and 226, there are obtained 5 rate dO/dt is greater than the value o, feedback control 
deviations between rotational displacement instruction with the gyro 1 is executed. The gyro 1 receives the 
signals from the integrators 21a and 216 and the feed- yaw rate d0/dt output from the operator 8 and multi- 
back rotational displacements signals Vol and Vor> and plies it by the gyro constant Kg (rad/s / rad/s). The 
provided actual rotational displacement signals which resulting output is transmitted to the A/D converter 2. 
show the displacements of actual rotations. The actual 10 The A/D converter 2 converts the given signal to a 
rotational displacement signals are output to the D/A digital mode signal. This digital mode signal is input 
converters 23a and 23b. The actual rotational displace- into the gyro integrator 3. The gyro integrator 3 com- 
ment signals are converted to analog mode signals using prises an integrator 3a and an operator 36. The output 
a voltage conversion constant Ki (V/number of pulses) from the A/D converter 2 is input into the integrator 3a 
in the D/A converters 23a and 23b. The analog mode 15 and is integrated per the predetermined time to obtain a 
signals are output to the comparators 24a and 246. The travel eccentric angle Or (rad). The result is output to 
velocity feedback signals VrL and V r R output from the the operator 3ft. The conversion of the unit of the angle 
velocity feedback circuits 26a and 26b are also transmit- Or is performed by the operator 36. A travel eccentric 
ted to the comparators 24a and 246. The velocity feed- angle Or (deg) is thus produced as output The travel 
back circuits 26a and 266 convert the rotational veloci- 20 eccentric angle 9r corresponds to a yaw angle and is an 
ties of motors 4a and 46 to voltage signals, using the angle of deviation from an actually instructed direction 
velocity voltage conversion constant K3 (V/number of to the vehicle 32. As described above, the travel eccen- 
pulses per unit time). These voltage signals are output to trie angle Or is input to the main control apparatus 10 
the comparators 24a and 246. and is given to the comparator 11 through the switch 

There are obtained values which are composed of the 25 12. In the comparator 11, a direction instruction value 
actual rotational displacements expressed by the volt- 0s from the exterior are compared with the travel ec- 
age signals and the deviation values between the rota- centric angle Or from the gyro integrator 3. Thus the 
tional displacements to be made which are outputted difference 0s~0r is obtained. The values 0s—0r is 
from the D/A converters 23a and 236 and the actual input to the left motor velocity instruction component 
rotational composite values are outputted to differential 30 13 and to the right motor velocity instruction compo- 
amplifiers 25a and 256. The differential amplifiers 25a nent 14 as a corrected direction instruction value 0£. 
and 256 amplify the outputs from the comparators 24a The left motor velocity instruction component 13 and 
and 246 at a predetermined gain K2 (V/V) and transmit the right motor velocity instruction component 14 gen- 
the outputs to the motors 4a and 46, respectively. The erate velocity instruction signals Pl and Pu on the basis 
motors 4a and 46 rotate on the basis of the output sig- 35 of the corrected direction instruction value 0e- The 
nals from the differential amplifiers 25a and 256. velocity instruction signals Pl and Vr are transmitted to 

As described , above, in the control system, only the the motor control apparatus 20. As described above, the 
motor feedback control is executed when the travel control can be executed without being influenced by an 
eccentric angle 0 is less than a specific value W or when integration error in the gyro integrator 3 or an error in 
the yaw rate d0/dt is less than a specific value o>. In this 40 the output signal caused by voltage drift, when the 
case, not only are velocity controls executed by the value of the travel eccentric angle is small. This can be 
velocity instruction signals Pl and Vr output from the accomplished by executing control, using only a feed- 
main control apparatus 10, but feedback controls are back control based on the rotational displacement of a 
also executed to apply corrections to the rotational motor. 

displacements which are made per predetermined time. 45 It is impossible to cope with the trouble by only a 
Therefore, correction of the direction can be effectively motor feedback control system, when a disturbance 
achieved even for an uneven surface which hinders the such as a slip of a wheel occurs and the travel eccentric 
vehicle 32 to travel in an instructed direction. angle becomes larger than a predetermined value. This 

It is possible to output the angle 0 by providing oper- is because rotational displacement becomes too large to 
ators 6a and 66, a comparator 7, an operator 8, an inte- 50 be detected as data with the velocity encoders 5o and 56 
grator 9, and an operator 31, while those components when a slip of a driving wheel occurs. In such a case, a 
are not directly necessary for the feedback control to gyro feedback control system is added to the motor 
output a travel eccentric angle 0. The operators 6a and feedback control system. The gyro 1 has detected data 
66 detect the rotational velocities of the motors 4a and of the yaw rate of the vehicle 32 which is not influenced 
46 respectively. There obtained the left-side velocity 55 by the slip of a driving wheel. Therefore, it is possible to 
Vector VLand right-side velocity vector Vr by using a correct the direction of the vehicle 32 even in a state 
velocity reduction ratio N (rad/s / rad/s) and the diam- where the disturbance occurs. 

eter D of the driving wheel. The velocity vectors Vl As described above, it is possible to make a proper 
and Vr are input into the comparator 7, where the value correction of the direction of a vehicle in compliance 
of the difference Vl— Vr is obtained. This difference is 60 with the circumstances by executing the gyro feedback 
output into the operator 8. The operator 8 obtains the control corresponding to the magnitude of the travel 
yaw rate dO/di (rad/s) by multiplying the value eccentric angle. 

Vl— Vr by 1/L, the reciprocal of the interval L be- While the presently preferred embodiment of the 
tween the driving wheels. The resulting output is trans- present invention has been shown and described, it is to 
mitted to the integrator 9. The integrator 9 obtains the 65 be understood that this disclosure is for the purpose of 
travel eccentric angle 0 (rad) by integrating the yaw illustration and that various changes and modifications 
rate dO/dt per the predetermined time. The operator 31 may be made without departing from the scope of the 
converts the unit of angle from the radian to the degree invention as set forth in the appended claims. 
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What is claimed is: 

1. A control system for a self-moving vehicle having 
a pair of drive shafts coaxially provided under each left 
and right side of said self-moving vehicle, a pair of 
driving wheels supported on said driving shafts, each 5 
motor connected to said driving shafts, and a gyroscope 
mounted on said self-moving vehicle for detecting a 
direction to move and for generating a gyro signal, the 
control system which comprises: 
an encoder connected to each driving wheel for de- 10 
tecttng each speed of said wheels and for produc- 
ing a speed signal; 
an A/D converter responsive to said gyro signal for 
converting an analogue signal into a digital signal 
and for generating said digital signal; 15 
a gyro integrator responsive to said digital signal for 
integrating said digital signal and for generating a 
feedback signal; 
a main controller responsive to said feedback signal 
for calculating a rotational speed of said motor and 20 
for generating a command signal; 
a motor controller responsive to said speed signal and 
said command signal for integrating both said sig- 
nals per a predetermined time and for correcting 
said command signal; and 25 
said main controller derives a correction signal of 
said command signal by integrating a yaw rate per 
said predetermined time when said yaw rate is 
higher than a predetermined value so as to obtain 
self-moving vehicle without receiving an error 30 
from said gyro. 
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2. A control system for a self-moving vehicle having 
a pair of drive shafts coaxially provided under each left 
and right side of said self-moving vehicle, a pair of 
driving wheels supported on said driving shafts, each 
motor connected to said driving shafts, and a gyroscope 
mounted on said self-moving vehicle for detecting a 
direction to move and for generating a gyro signal, the 
control system which comprises: 
an encoder connected to each driving wheel for de- 
tecting each speed of said wheels and for produc- 
ing a speed signal; 
an A/D converter responsive to said gyro signal for 
converting an analogue signal into a digital signal 
and for generating said digital signal; 
a gyro integrator responsive to said digital signal for 
integrating said digital signal and for generating a 
feedback signal; 
a main controller responsive to said feedback signal 
for calculating a rotational speed of said motor and 
for generating a command signal; 
a motor controller responsive to said speed signal and 
said command signal for integrating both said sig- 
nals per a predetermined time and for correcting 
said command signal; and 
said main controller derives a correction signal of 
said command signal by integrating a yaw rate per 
said predetermined time when an integrated yaw 
rate per said predetermined time is higher than a 
predetermined value so as to obtain self-moving 
vehicle without receiving an error from said gyro. 
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